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SUMMARY 


In this report, we present the research results from the research grant entitle ” Development of 
Advanced Control Schemes for Telerobot Manipulators,” funded by the Goddard Space Flight 
Center, under the Grant Number NAG 5-1124 for the period between March 1, 1989 and August 
31, 1989. 


This report presents the design of a joint-space adaptive control scheme for controlling the 
slave arm motion of a dual-arm telerobot system developed at Goddard Space Flight Center 
(GSFC) to study telerobotic operations in space. Each slave arm of the dual-arm system is a 
kinematically redundant manipulator with 7 degrees of freedom (DOF). Using the concept of 
model reference adaptive control (MRAC) and Lyapunov direct method we derive an adapta- 
tion algorithm which adjusts the PD controller gains of the control scheme. The development 
of the adaptive control scheme assumes that the slave arm motion is non-compliant and slowly- 
varying. The implementation of the derived control scheme does not need the computation of the 
manipulator dynamics, which makes the control scheme sufficiently fast for real-time applica- 
tions. Computer simulation study performed for the 7 -DOF slave arm shows that the developed 
control scheme can efficiently adapt to sudden change in payloads while tracking various test 
trajectories such as ramp or sinusoids with negligible position errors. 


1 INTRODUCTION 


Telerobotics, a concept combined by two principles, teleoperation and robotics [1] has attracted 
tremendous research attention because it has potential applications in hazardous environments 
such as the future NASA space station, nuclear power plants, or undersea. Extravehicular 
activities such as assembly, maintenance or inspection in space, can be made less dangerous by 
cooperating astronauts and telerobots in a telerobotic operation. Depending on the complexity 
of the task to be performed, the astronaut can be either assisted or replaced by the telerobot. 
Teleoperations can be performed either in a teleoperated control mode or in a autonomous control 
mode [2]. In the teleoperated control mode, the astronaut remotely controls the motion of the 
slave arm of the telerobot using a master arm system. On the other hand, the slave arm 
performs its motion autonomously under the supervision of the astronaut, in the autonomous 
control mode. In any mode, to achieve a successful task, precise control of the slave arm motion 
should be ensured. 

Goddard Space Flight Center (GSFC) is developing a Flight Telerobotic Servicer (FTS) 
to perform a variety of tasks on the NASA space station, which include assembly, inspection, 
servicing, and maintenance. To support the FTS development, a dual-arm telerobot system 
consisting mainly of a pair of 6-DOF mini-master controllers and a pair of 7-DOF slave arms 
has been built at GSFC to serve as a testbed for studying a variety of issues such as zero-g 
operation, dual-arm robot control, advanced control schemes, and hierarchical control etc. [3]. 
This report concerns with the motion control of the slave arm which is a kinematically redundant 
robot manipulator. 

Control of redundant robot manipulators, defined as manipulators having more DOF than 
necessary to perform a specified tasks has been an active research area [4]-[7] because of its many 
advantages including the use of extra DOF to maneuver in a congested workspace and avoid 
collisions with obstacles. Most conventional control schemes such as Computed Torque Tech- 
nique [8], are derived based on the dynamic modeling the robot manipulator. Since in addition 
to the massive computation requirement in evaluating dynamic models in real-time control, it 
is almost impossible to derive an accurate dynamic model for a robot manipulator, the above 
developed control schemes are generally not feasible. In an attempt to alleviate the problem 
of uncertainties in manipulator dynamics and payloads, considerable research effort has been 
focused on studying Adaptive Control [9]. Lyapunov method and MRAC were used to design 
adaptive controllers for trajectory control, which was proved to provide global stability [10]. 
The authors in [11] considered the design of robust adaptive controllers. Adaptive force control 
problem was investigated in [12] for a cutting problem. In [13] an adaptive force-position con- 
troller with self-tuning was designed in Cartesian space by using eigenvalue assignment method 
and minimization of a quadratic performance criterion. Research work in [14] resulted in the 
development of a decentralized adaptive control scheme based on independent joint control con- 
cept. A joint-space adaptive control scheme was developed in [15] to control the motion of a 
robotic end-effector with closed kinematic chain mechanism [16]. The problem of hybrid control 
of force and position was considered in [17]. Employing the Kalman filter, the authors in [18] 
proposed an approach to adaptive control of manipulators based on an identification scheme. 
Recently, MRAC and Lyapunov method were employed in [19] to design a joint-space adaptive 
control scheme for a telerobot manipulator. 

The organization of this report is as follows. In the next section, we first describe the struc- 
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ture and operations of the GSFC telerobot testbed. Next a joint-space adaptive control scheme 
is developed using MRAC and Lyapunov method. We then present the computer simulation 
performed to study the performance of the developed adaptive control scheme which is imple- 
mented to control the motion of the 7 DOF slave arms, and evaluate the simulation results. 
Finally in the conclusion, we discuss the results of the report and outline some future research 
directions. 

The following notations are used in this report: 

• M r : transpose of the matrix M 

• 0 n : (nxn) matrix whose elements are all zero 

• In: (nxn) identity matrix. 

2 THE NASA TELEROBOT TESTBED 

Figure 1 presents the dual-arm telerobot system recently developed at GSFC to serve as a testbed 
for investigating the feasibility of telerobotic operations in space. The system mainly consists 
of a pair of slave arms, each of which is a 7-DOF kinematically redundant robot manipulator, 
manufactured by Robotics Research Cooperation (RRC) and a pair of 6-DOF Kraft Mini-Master 
(KMM) hand controllers from Kraft Telerobotics, Inc. At this time, the RRC controllers have 
been modified by GSFC engineers to allow implementation of advanced control schemes, and to 
incorporate other advanced features such as high-speed parallel processing. 

The operations of the telerobot system can be best explained using the block diagram given 
in Figure 2. The RRC slave arm system receives actual data of joint force and joint posi- 
tions/velocities via force sensors and joint position/velocity sensors mounted on the slave arms. 
Joint forces that are transmitted to the KMM system for force reflection can be determined 
using the slave arm joint forces. In a teleoperated control mode, the human operator residing 
in an operator control station such as Space Shuttle, Space Station, or on ground, controls the 
motion of the slave arms via the mini-master controllers using familiar hand and arm move- 
ments while observing the slave arm motion and the task space from a cupola, a window or a 
TV monitor. The force/torque applied by the human operator produces 6 joint positions in the 
master arm system, which then are converted to 7 corresponding joint positions in the slave arm 
system through an appropriate coordinate transformation. The 7 joint positions of the slave 
arms will then serve as the desired variables to be supplied to a control system in the RRC sys- 
tem. Based on the difference between the desired joint variables and the actual joint variables 
of the slave arms, provided by feedback data, the controller then employs a control scheme to 
provide necessary control signals to the actuators of the slave arms so that it tracks the desired 
motion as closely as possible while maintaining a desired contact force on the task environment. 
In an autonomous control mode where the slave arms perform the task autonomously while the 
human operator plays only a supervisory role, the desired inputs to the slave arm control system 
can be generated by a Path Planner. 
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3 DESIGN OF THE ADAPTIVE CONTROLLER 


Since the desired inputs to the slave arm control system are expressed as joint variables, as 
explained in previous section, a joint-space control scheme should be considered to avoid the 
time-consuming evaluation of the forward and inverse kinematics when a Cartesian-space control 
scheme is employed in real-time control. Also to effectively react to the nonlinearity of the 
manipulator dynamics, errors in dynamic modeling, and sudden change in payloads, adaptive 
controllers should be developed instead of fixed-gain controllers which work well only when the 
manipulator stays within the linearized operating region [10]. 

The following development of the adaptive control scheme focuses on controlling the motion 
of a single slave arm performing non-compliant motion, i.e. the slave arm moves freely in space 
without being in contact with the environment. In this case, pure position control scheme can be 
employed to control the motion of the slave arm, since contact force control is not needed. Hybrid 
position/force control scheme can be applied in the case of compliant motion [17]. Furthermore, 
we assume that the arm motion is slowly varying because rapid motion of the slave arms is 
considered to be dangerous during a telerobotic operation, especially in obstacle avoidance. 

The dynamics of the 7-joint slave arm can modeled by the following nonlinear vector differ- 
ential equation [19]: 

T (0 = M(q, q) q (t) + N(q, q) q (t) + G(q, q) q (t) (1) 


where q(t) denotes (7x1) joint positions of the slave arm, r(t), the (7x1) joint force vector, 
M(q,q), the slave arm mass matrix is a symmetric positive-definite matrix of order (7x7), 
N(q, q) and G(q, q) are (7x7) matrices whose elements are highly complex nonlinear functions 
of q and q. In the right-hand side of (1), if we neglect joint friction, the second term represents 
the centrifugal and Coriolis forces, and the third term the gravity forces. 

An adaptive controller consisting of a Proportional (P) and a Derivative (D) terms is defined 
by 

r(f) = K p (t) q e (t) + K d (t) q,(<) (2) 

where 

qe(0 = q d(t) - q(0 (3) 

denotes the joint error vector between the actual joint vector q(t) and the desired joint vector 
q d (t), K p (t) and Kj(t) are the matrices of the proportional and derivative terms, respectively, 
of the adaptive controller. 

Substituting (2) into (1) yields 

M^ + (N + K J )q e + (G + K p )q e = Mq J + Nq ti + Gq J (4) 


where the dependent variables of the matrices and vectors were omitted for readability. 

In order to transform (4) into a state space form, we proceed to define a (14x1) state vector 
z(t) such that 

z (0 = [qf(0 q I(*)] T > (5) 

which rewrites (4) as 


z(t) = 


O7 O7 

-A, -A 2 


z(t) + 


O7 O7 O7 
A3 A 4 I7 


u(0 


( 6 ) 
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where 


Ai = M -1 (G + K p ), A 2 = M- 1 (N + K << ), 

a 3 = m- 1 g, a 4 = m~ 1 n, 


(7) 


and 

and 


»(*)= [qJ(0 qJ(0 qJ(0] r - 


( 8 ) 

(9) 


In the framework of MRAC, Equation (6) represents the adjustable system. The desired 
performance of the slave arm motion can be specified by a reference model in terms of the 
tracking error vector q e (f) = [<7ei(0 < 7 e 2 (t) • • • 9e7(t)] T . Suppose the tracking errors q e i(t) for 
i=l,2 v . . ,6, are decoupled from each other, and satisfy 


Qei(t) + 2 & Ui q ei (t) + uf q ei (t) = 0 


( 10 ) 


for i=l,2,. ..,6, where and a;,- denote the damping ratio and the natural frequency of q e i, 
respectively. Then the dynamics of the reference model can be represented by 


z m (t) = D z m (t) = 


O7 Ir 

-Di D 2 




( 11 ) 


where Di=diag(wf) and D 2 =diag(2^,w,) are constant (7x7) diagonal matrices, and 

»-«=[<£« tf(«)] T (12) 

with 

q m = (?e 1 9e 2 • • • 9e • (13) 

Solving (11), we obtain 

z m {t) = exp(Df) z m (0). (14) 

We note from (14), that if z m (0) = 0, i.e. the initial values of the actual and reference joint 
vectors are identical, then z m (<) = 0. 

Now if e(t), the adaptation error vector is defined as 


e(0 = z m (t) - z(t), 


then from (6) and (11), we obtain an error system described by 


e(t) 


O7 I7 

-Dj — D 2 


e (0 + 


O7 O7 

Ax “ Dx A2 — D2 


Z (t) 


07 07 07 

—A3 — A4 — 17 


u(t). 


We proceed to select a Lyapunov function candidate v(t) such that 
v(t) = e r Pe + tr [(Ai - Di) t Hi(Ai - Di)] 
+/r[(A 2 -D 2 ) T iI 2 (A 2 -D 2 )] 
+tr[AjiT 3 A 3 ] + tr[Aj II 4 A 4 ], 


(15) 


(16) 


(17) 
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where <r[M] is the trace of matrix M, P and J7 ; for i=l,2,. ..,4, are positive definite matrices 
to be determined later. 

Taking the time derivative of (17) and simplifying the resulting expression, we obtain 


where 

and P is given by 


v(t) = e T (PD + D T P)e 

+2 tr [(Ai - Di) r (rtqJ + J7x A a )] 
+2 tr j(A a - D 2 ) T (rtc£ + 77 2 A 2 )] 
-2 tr [A 3 T (f2qJ - II 3 A 3 ) 

-2 tr [A 4 T (I2qJ - i7 4 A 4 ) 


12 = [p a p 3 M 0 = -P 2 q e - P 3 q e 


P = 


Pi P 2 

p 2 p 3 


(18) 

(19) 

( 20 ) 


and it is noted that e(t ) = -z(t) since z m (t) = 0. 

In (10) £, and u can be selected so that D is a matrix having stable eigenvalues, which 
is also called a Hurwitz matrix [20]. Therefore according to Lyapunov theorem, for any given 
positive-definite symmetric matrix Q, there exists a positive definite symmetric matrix P that 
satisfies the Lyapunov equation 

PD + D r P = -Q. (21) 

Now in (18), if we set 

llqj ■)■ H 1 A 1 = ■)■ JT 2 A 2 — 0 (22) 

and 

J?qj — II 3 A 3 = iRqJ — J7 4 A 4 = 0, (23) 

then (18) becomes 

i)(t) = — e r Qe (24) 

which is a negative definite function of e(t). Furthermore, from (22)-(23), we obtain 


A l = -n?n& a 2 = -n?fii£, (25) 

and 

A 3 = iIJ 1 «qI'; A 4 = iI7 1 «qJ. (26) 

We already showed that P is a positive definite matrix. Now if we could show that i7, 
for i=l,2,. ..,4, are also positive definite matrices, then the error system described in (16) is 
asymptotically stable, i.e., e(t) — ► 0, or z{t) — ► z m as t — * oo. 

As mentioned earlier, since we assume that the slave arm performs slowly varying motion, M, 
N and G are slowly time-varying matrices which can be considered as nearly constant matrices. 
Consequently from (7) and (8) we obtain 

Ax ~ M _1 K P ; A^M^kj (27) 
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and 


( 28 ) 


A 3 ~ 0; A 4 ~ 0. 

Next substitution of (27)-(28) into (25)-(26) yields 

M- 1 k p = -n?fi<g; M~ 1 k d = -n?n<£, ( 29 ) 

and 

O-TT^flqJ; O^U^rtqJ. (30) 

Now in (29), letting 

J7x = - — M; n 2 = M, (31) 

ai a 2 

where ai and a 2 are arbitrary positive scalars, and solving for K p and Kj, we obtain 

K p = Oxf2qf, (32) 

and 

k d = a 2 n qj. (33) 

In (31), we note that JIi and JI 2 are positive definite matrices that can be considered 
as nearly constant because the slave arm mass matrix M is positive definite and slowly time- 
varying. To satisfy (30), H 3 and II 4 should be chosen such that their determinants approach 
00 in addition to the positive definite property. To achieve this, we can select 17 3 and U 4 such 
that they are diagonal matrices whose main diagonal elements assume very large positive values. 
Now integrating both sides of (32) and (33) yields 

K„(0 = K p (0) + ax A P 2 q e + Pa^hiT dt (34) 

JO 

and 

K d (t) = K d ( 0 ) + a 2 f\p 2 q e + P 3 q e )q *dt (35) 

Jo 

where K p (0) and K<x(0) are initial conditions of K p (t) and Ki(t), respectively and can be set 
arbitrarily. 

Solutions for the controller gain matrices of the adaptive controller are given in (34) and 
(35). The adaptation scheme, as illustrated in Figure 3 is mainly based on the errors of the joint 
variables of the slave arm and the submatrices of P. Since P is a constant matrix and q e can 
be easily computed from the desired and actual joint variables available from the master arm 
system and feedback data, respectively, the computation time required to calculate the adaptive 
control law given in ( 2 ) is relatively small. Consequently, high sampling rates up to 1 KHz 
can be utilized in the implementation of the proposed control scheme. Thus the manipulator 
dynamics can be considered almost constant during each sampling interval of typically about 1 
ms. This feature of the proposed scheme is very attractive to real-time control implementation. 
We also observe that unlike other conventional adaptive control schemes designed using MRAC, 
the implementation of the developed adaptive control scheme does not require the slave arm 
dynamics. 
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4 COMPUTER SIMULATION STUDY 


In this section, using computer simulation we examine the performance of the developed adaptive 
control scheme which is applied to control the motion of the 7 -DOF RRC slave arm illustrated 
in Figure 4. A complete list of the slave arm parameters can be found in [21]. In the following 
we will report two study cases. In the first case, the slave arm is controlled so that the 7 joints 
variables follow a set of desired ramp trajectories while suffering from step change of payload. In 
the second case, the 7 joint variables are controlled to track a set of desired sinusoidal trajectories 
during step changes in payload. In the second case, we will also compare the performance of 
fixed-gain controller versus the developed adaptive controller in terms of tracking capability. 
The computer simulation study is performed using a modified version of Manipulator Simulation 
Program (MSP) [21]. 

Controller Parameters 

• Adaptive Controller. £, and w; for i=l,2 were selected so that 2 characteristic roots of 
(10) are -1 and -2. In this case, we have Di = 2Ir and D 2 = 3 I 7 . Selecting Q,- = In for 
i= 1 , 2 ,. . . ,6 and solving ( 21 ) using MATLAB we obtain P 2 = P 3 = O. 25 I 7 . The adaptation 
law can be now implemented by substituting the derived values of P 2 and P 3 into (34)-(35) 
where K p (0) and K<f(0) can be arbitrarily set. The scalars <*1 and 02 can be adjusted to 
improve the tracking quality provided that they always assume positive values. 

• Fixed-Gain Controller. In the case of fixed-gain controller, we use K p = diag(2925, 1912.5, 
630, 360, 607.5, 24.4125, 5.67) and K d = diag(416, 272, 89.6, 51.2, 86.4, 3.472, 0.8064), 
which are identical to K p (0) and K^( 0 ) of the adaptive controller, as specified above. 

4.1 Payload Change 

Step change in payload occurs when the slave arm drops a load it is carrying, performs some 
tasks, and picks up the same load later. To study the adaptability of the control schemes in the 
above situation, we first set the payload at 70 lb. and drop it to 1/3 of the initial payload at 
1/3 of the simulation time and then increase it to full payload at 2/3 of the simulation time. 
Sudden payload changes are modeled by delayed step functions. 

4.2 Tracking Ramp Trajectories 

In this case the adaptive control scheme is applied to control the motion of the slave arm so that 
its joint variables follow a set of desired ramp trajectories. For each joint, the initial (I) and final 
(F) desired joint angles (A) are specified by the user, and the desired velocity is simply obtained 
by dividing the difference between the final and initial desired joint angles by the simulation 
time which is 50 seconds in all cases. Initial and final joint angles used in this case are given in 
the following vectors showing the data in the order starting with Joint 1 and ending with Joint 
7: IA = (0, 90, 0, 0, 0, 0, 0); FA = (195, 250, 305, 128, 200, 95.5, 270) with all data in degrees. 
Simulation results presented in Figure 5 show that the joint angles track their corresponding 
desired trajectories very closely with some negligible off-track errors in Joints 3, 4 and 6 at the 
transition of sudden payload changes. 
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4.3 Tracking Sinusoidal Trajectories 

In this case the slave arm is controlled so that its joint angles track a set of desired sinusoidal 
trajectories. The desired trajectory is specified by = IA + 229sin(Vt) where IA denotes the 
initial joint angle, V = fj and with tf = 50 seconds, the simulation time. The desired velocity 
is obtained as q(t ) = 229Vcos(Vt). In this case we use IA = (0, 30, 60, 0, 30, 60, 90) and 
from qi the desired final angle at the end of the simulation is equal to IA. Figure 6 presents the 
simulation results which show excellent tracking quality in all joints despite sudden change in 
payloads. Finally, to make a comparative evaluation of the developed adaptive control scheme, 
we now control the slave arm using the fixed-gain controller as specified before to track the same 
sinusoidal trajectories as in the case of the adaptive controller. As Figure 7 illustrates, tracking 
quality is deteriorated in Joints 6 and 7 because the controller is unable to react to the dynamic 
and static coupling between the joints and to sudden change in payload. 

5 CONCLUSION 

In this report, employing the concept of model reference adaptive control and Lyapunov method, 
we have developed a joint- space adaptive control scheme which is suitable for controlling non- 
compliant motion of robot manipulators performing slowly varying motion. The developed 
adaptive control scheme was applied to control the motion of the kinematically redundant slave 
arm of a telerobot system built at Goddard Space Flight Center to study teleoperation. Com- 
puter simulation of the control scheme implementation showed that the adaptive control scheme 
provided good tracking quality in spite of dynamic and static coupling between joints and sudden 
change in payload. Simulation results also showed that fixed-gain controller failed to effectively 
react to above disturbances. Current research activities are focusing on the development of 
an adaptive control scheme in Cartesian space for redundant manipulators and on compliant 
control of the slave arm motion using a hybrid position /force control [17]. 
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Figur* 1: The GSFC Telerobot Teethed 





Figure 3; The adaptive control scheme in Joint- space 
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Figure 5: Tracking Ramp Trajectories 
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